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ABSTRACT 


This  paper  deals  with  the  problem  of  sound  speed  estima¬ 
tion  as  an  aid  in  improving  our  knowledge  of  the  position  of  a 
drifting  sonobuoy  This  a  accomplished  by  processing  the  out¬ 
puts  of  a  spatially  displaced  set  of  hydrophone  sensors  in  an 
extended  Kalman  filter.  The  filter's  stilt  vector  may  be  aug¬ 
mented  to  provide  estimates  of  the  sonobuoy  s  position, 
velocity,  and  the  sound  speed  from  the  sonobuoy  to  each  of  the 
hydrophones. 

It  is  shown  that  with  just  time-of-amva)  difference  and 
doppter  difference  measurements,  system  observability  is  mar¬ 
ginal  -  directly  resulting  to  biased  estimates  of  the  sonobuoy 's 
location.  With  the  additional  use  of  bearing  measurements,  it  is 
then  shown  how  this  enhances  system  observability  and,  conse¬ 
quently,  estimation  performance. 


I.  INTRODUCTION 

In  this  paper,  we  arc  concerned  with  the  accurate  location 
Of  a  sonobuoy  over  a  specified  interval  of  time.  It  is  assumed  to 
be  subjected  to  both  random  and  deterministic  forces  over  this 
same  tune  period.  Because  of  this,  our  knowledge  of  the  soik^ 
buoy's  location  is  uncertain  and  can  be  in  error  if  we  employ 
conventional  dead  reckoning  methods 

Another  approach  more  accurate  than  the  above  would  be 
to  place  a  source  emitting  a  continuous  pseudorandom  gaustaan 
signal  aboard  the  sonobuoy.  A  set  of  three  or  more  passive 
hydrophones,  geographically  separated  (ram  one  another,  can 
then  be  used  to  pick  up  the  sonobuoy  *s  signal  to  provide  meas¬ 
urements  of  sound  ume-of-amval  difference  and  doppler  dif¬ 
ference  As  an  example,  one  configuration  involving  three 
hydrophones  is  shown  below  in  Figure  1 . 

In  this  figure  Rj,  1*1, 2. 3  represents  the  distance  from  the 
sonobuoy  to  each  of  the  hydrophones  and  Cj,  i»l ,  2.  3  represents 
the  sound  speed  to  each  hydrophone.  Note  that  we  are  uang 
three  distinct  sound  speeds  instead  of  a  single  one.  This  is 
because  sound  speed,  in  a  thermally  non-homogeneous  medium, 
is  related  in  a  complex  fashion  to  such  variables  as  umc-of-day, 
distance  between  hydrophone  and  sonobuoy,  bearing  of  hydro¬ 
phone  with  respect  to  sonobuoy,  etc. 

Now  if  we  consider  any  pair  of  hydrophones,  pair  1-2  for 
instance,  then  we  can  obtain,  through  cross-correlation  methods, 
two  measurements,  ume-of-amval  differences  and  doppler  differ¬ 
ence.  that  are  related  to  the  sonobuoy 's  location  by  the  following 
equations. 


“1-2  *  7 


*1  h 

*1  ’  *2 


in  Equation  ( I).  represents  (be  sound  ttme-of-amval 
difference  for  the  hydrophone  array  pait  1-2.  tj.j  in  Equa¬ 
tion  (2)  represents  the  normalized  doppler  difference,  ^ ,  where 
f  is  the  base  frequency  of  the  narrowband  source. 

Using  spherical  geometry,  the  distances  R,  and  tune  rate- 
of-change  distances  r,  are  related  to  the  sonobuoy 's  location  by 
the  following  equations: 

Itj  *  cos'*  lain  x,  sin  A,  ♦  cotxj  cosXj  cos  (xj -6j>]  (3> 
k  *3  (tin  Xj  cos  Xj  cos  Uv*0i>* cos  *j  sink  j) 

7 

(4) 

♦  »4  cos  x  j  cos  Xf  sin  tx^  -  6,) 
sUnTT 


xj,  i* I,  2,  3.  4  represents  the  sonobuoy  latitude,  longitude, 
latitude  rate,  and  longitude  rate,  respectively. 

Xj.  6r,  represents  the  latitude  and  longitude  of  the  i*** 
hydrophone. 

In  Equation  <4  j  it  was  assumed  that  each  of  the  hydrophones  was 
stationary. 

Because  of  the  nonlinear  feature  of  the  above  measurement 
equations,  it  is  very  difficult  to  solve  explicitly  for  the  sono- 
buoy'i  suit  vector  \\\ ,  x^,  xj,  xq).  In  the  next  section,  it  will  be 
shown  how  this  state  vector  may  be  obtained  in  a  recursive 
manner  using  an  extended  Kalman  filter. 

Following  this  we  will  show  that  when  the  sound  speeds  are 
imprecisely  known,  then  estimates  of  the  sonobuoy *s  position 
and  velocity  become  biased.  Section  3  then  presents  a  method 
for  augmenting  the  sound  speeds  to  the  sonobuoy  state  estimate 
and  it  ts  shown  that  the  augmented  state  becomes  marginally 
observable.  This  directly  results  in  biased  estimates  for  the  sono- 
buoy's  state  vector.  We  then  show  that  the  additional  use  or 
bearing  measurements  are  seen  to  enhance  system  observability 
to  the  point  where  estimation  of  the  sonobuoy  state  vector 


R,  Rv 

M  *1  c2 


Fmatty,  m  Section  4,  we  wft  summarise  our  results. 
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1  ESTIMATION  OF  SONOMJOY  STATE  VECTOR 
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ll  a  apparent  from  Equations  ( 1  Ho  (4)  (hat  it  would  be 
difficult  to  solve  for  tfeac  sonobuoy  slate  vector  hi  terms  of  the 
measurement  r^,  a^j.  A  recursive  approach  may  be  sought  that 
avoids  this  difficulty.  The  approach  we  use  here  involves  appli¬ 
cation  of  an  e* tended  Kalman  filter. 


In  order  to  implement  this  filter,  we  need  in  addition  to 
the  measurement  Equations  t 1 1  to  H).  a  model  lor  the  dynamics 
of  the  system-  This  is  easily  obtained  when  we  assume  a  constant 
speed  and  constant  course  drift  and,  in  addition,  a  random  per¬ 
turbation  to  account  for  modeling  uncertainties,  environmental 
forces,  etc.  In  discrete-time  form,  the  equations  for  the  system 
dynamics  arc  given  by  . 
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Hk>  * 


*1  (k) 
*2<k) 

*j  (k) 
*4  (k) 


is  the  sonobuoy  stele  vector 


At  *  sampling  interval 

W3  <k),  w4  (k )  are  zero  mean,  random,  white  noise 
•equences 

E  \  w(k)»T(jl|  •  Qk  d^i;  *kj  “ lhe  KrotttktT  Wli. 


represents  the  nonlinear  dependence  of  1^  on  alkl  defined  by 
Equations  (I  I  through  (4)  Kg  is  the  covariance  mains  of  an 
additive  white- noise  measurement  sequence.  H  tsfk«)/k»  is  the 
measurement  equation  that  is  linearized  about  the  most  current 
state  estimate  and  is  defined  by: 


H(ilk4l/k») 


ah<S(kl) 

~a*?rr 


Uk)  «  JiU+j/fc) 


This  linearization  was  found  to  accurately  describe  the  func¬ 
tional  cham ct ensues  of  flic  nonlinear  measurement  model  as 
H(  *>  was  relatively  insensitive  to  variation  in  Sfk). 

These  equations  were  implemented  m  the  case  where  we 
knew  the  sound  speeds  to  each  hydrophone.  Under  these  esreum- 
stances,  the  resulting  estimation  performance  was  seen  to  be 
excellent. 

However,  for  the  case  involving  unknown  sound  speeds,  the 
estimation  performance  degrades  rapidly  when  we  use  incorrect 
values  for  the  sound  speed*  in  the  Kalman  filter.  An  example  of 
this  is  shown  in  Figures  2  and  3  for  a  case  involving  sn  average 
sonobuoy  dull  velocity  of  l  knot  and  tonne  of  45  degrees.  In 
Figure  2,  the  solid  curves  represent  motion  of  the  truth  model 
and  the  dotted  curves  represent  estimates  of  the  sonobuoy  state 
as  provided  by  a  Kalman  filter.  The  measurements  were  assumed 
noisy  with  a  standard  deviation  in  t  and  ft  of .  I  second  and 
1  x  10‘S,  respectively.  The  estimation  error  and  a  poon/a  pot- 
tenon  standard  deviations  arc  presented  m  Figure  3.  A  aet  of 
three  hydrophones  were  configured  essentially  as  vertices  of  an 
equilateral  tnangie  with  the  sonobuoy  starting  near  the  center  of 
this  triangle  The  truth  model  sound  speeds  were  aet  at:  cj  * 
4857  ft/sec.  cj  *  4957  ft/sec,  and  C3  *  4757  ft/sec  around 
nominal  values  from  Urick  Hi.  The  Tiltcr  used  an  incorrect  value 
of  5000  ft/sec  for  aU  three  speeds  and  no  attempt  to  estimate 
them  was  made.  It  is  clear  from  Figure  2  that  significant  biases 
in  estimated  position  and  speed  develop. 

In  the  next  section,  we  will  sec  how  the  use  of  bearing 
measurements  enhances  system  observability  and  allows  unbiased 
estimation  of  the  sonobuoy  state  vector. 


If  we  linearise  the  measurement  equation  about  our  most  recent 
estimate  of  the  state,  &0a  to  obtain  a  linear  measurement 
matrix.  H(t(k)l,  we  can  then  implement  the  extended  Kalman 
filter  in  seal  time.  In  vector  matrix  form,  these  equations  are 
vecuravdy  green  by  |3| ; 

fifk+l/k)  •  +(At)t<k/k)  (6) 

Plk+l/k)  -  AlAilFtk/k)  «T<At)  +  Qg  (7) 

I(k+l/k+ll  *  S(k4l/k)  4  Kg  |ig  *  Wl(k4l/k))|  (8) 


3.  SOUND  SPEED  ESTIMATION 

Beaus.  >f  the  biases  that  develop  when  we  uae  incorrect 
sound  speeds  in  the  Kalman  filter,  it  was  felt  that  estimation  of 
these  sound  speeds  in  addition  1o  the  sonobuoy  states  would 
eliminate  the  biases.  This  is  done  simply  by  augmenting  the 
sound  speeds  to  the  original  four  nlemeqt  sonobuoy  state  vector 
The  assumption  was  made  that  thcVound  speed  was  constant  and 
unknown  over  a  sufficiently  long  time  interval.  Its  state  aquation 
is  then  given  by : 

dj  -  0;  i  »  1.2.3  (ID 


riktl/k4l>-  |l*KkHO<k4|/k»)  P(k4»/k> 

Kk  •  P(k4l/k)H(ft(k4|/k)MH(8(k4l/k))P(k4|/k) 
HT(fi(k4|/k)l4Rk]’1 


(*) 

(10) 


Equations  (6)  and  (7)  represent  predictions  of  the  state 
estimate  and  covariance  to  tif*e<k4|),  whereas  Equations  <•) 
through  ( 10)  update  the  state  estimate  and  covariance  to  account 
for  a  new  measurement  In  the  latter  art  of  equal  ions,  the 
measured  vector  u green  by  *k*  ■  I  r ^<k>,  orj(k)l ,  where  b< •  > 


Implementation  of  the  extended  Kalman  filter  for  the  aug¬ 
mented  state  vector  is  therefore  rather  simple  and  straightfor¬ 
ward  and  will  not  be  presented  here. 

Upon  implementing  the  augmented  state  filter,  it  was  found 
that  biases  still  developed  in  the  sonobuoy  states  and  sound 
speeds  for  a  number  of  scenarios  involving  different  starting 
positions,  speeds,  courses,  etc.  For  this  reason,  the  observability 
of  the  linearized,  augmented  state  system  was  explored  using  the 
information  matrix  (21 .  In  the  situation  involving  no  process 
none  and  state  vector  a  pnon  information,  the  information 
matrix  is  equal  to  the  inverse  of  the  Kalman  filter  covanance 
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main*.  H  lk/k>  This  Mtru  must  b«  positive  definite  for 
stochastic  obarnrabdity  and.  pro»d*d  the  above  conditions 
apply,  ts given  «  recursive  fonn  by: 


4.  CONCLUSIONS 


F^k/k)*  <k-l/k-l) ♦(•All 

(12) 

♦  htiiui»  r**1  Hau-n^r1  <o/o>«o 

where  iUUii  the  stale  transition  matrix  defined  m  (Si. 
Hiuk  l  h  » the  measurement  mama  linearized  about  the  state 
vector  Ilk-1) 

To  assess  the  property  of  stochastic  observability,  the 
norm aiued  eigenvalues  of  Uus  nutria  were  computed  (nor- 
maiiicd  to  one)  and  plotted  as  a  function  of  time.  Figure  4  shows 
the  results  that  were  obtained  for  the  cast  involving  one 
unknown  and  constant  sound  speed.  One  of  the  sonobuoy  posi¬ 
tion  eigenvalues  becomes  ill-conditioned  and  exhibits  a  smaller 
maximum  magnitude  than  the  other  position  eigenvalue  by  a  few 
orders  of  magnitude.  Thu  analysis  was  repeated  for  a  number 
of  different  sonobuoy  starting  positions  and  headings,  and  the 
same  general  result  was  obtained,  i.e.,  ill-conditioned  behavior 
of  one  of  the  eigenvalues.  Because  of  this  and  the  fact  that  the 
state  estimates  were  biased,  we  concluded  that  the  system  was 
marginally  observable 

As  a  means  of  improving  the  property  of  system  observa¬ 
bility,  w«  introduced  an  additional  measurement  of  bearing  to 
use  in  the  Kalman  filter,  toe  assumed  that  it  was  contaminated  by 
additive  while  noise  with  a  standard  deviation  of .  I  degree  These 
measurements  defined  the  bearing  of  the  sonobuoy  with  respect 
to  each  hydrophone,  and  are  normally  available  as  outputs  from 
the  same  set  of  hydrophones  without  introducing  additional 
irmorv 

The  Kalman  filter  was  then  rerun  with  these  additional 
measurements  and  the  sonobuoy  tracking  performance  was 
found  io  be  very  good.  Figures  S,  b,  7.  and  b  summarize  the 
result*  of  one  case  where  we  estimate  the  four  sonobuoy  states 
and  three  sound  speeds  In  Figure  5.  convergence  of  the  sono¬ 
buoy  stale  rsu mates  to  their  true  values  is  seen  to  be  very  rapid. 
Noise  was  introduced  in  the  sound  speed  truth  model  to  add 
more  realism  to  the  problem  and  this  variation  is  reflected  by  the 
sanation  in  sound  speed  of  the  truth  model  as  shown  in  Figure  6. 
Figures  7  and  4  present  estimation  error  and  standard  deviations 
of  the  sonobuoy  stales  and  sound  speeds.  These  errors  arc  seen 
to  fall  well  within  the  i  two-sigma  value  as  one  would  expect 
for  unbiased  estimation  A  number  of  other  cases  were  also  run 
and  are  not  presented  here  because  of  space  limitations  For 
these  other  cases  it  was  found  that  tracking  performance  was  as 
good  as  be  lore  and  all  of  the  earlier  noted  biases  in  the  slate 
estimates,  when  processing  only  unic4elay  and  floppier  differ¬ 
ence  measurements,  had  disappeared. 


To  sum  man  re  the  above  results,  we  saw  that  to  estimate  the 
sonobuoy  position  and  velocity  accurately  we  need  to  atsoasti- 
mate  the  sound  speeds  to  each  hydrophone  when  they  arc 
unknown  toith  the  aid  of  the  information  mains  we  found  that 
the  Unearned  system  was  marginally  observable  when  attempting 
to  estimate  both  the  sonobuoy  states  and  sound  speeds 

Because  the  Unearned  measurement  mode)  accurately  repm 
sen  led  its  nonlinear  counterpart,  we  concluded  that  Uw  nonlinear 
system  was  also  marginally  obertvebte.  This  was  abo  icftectofl 
by  the  biased  estimates  of  tonobuoy  position  when  implementing 
the  Kalman  filler 

Finally,  by  incorporating  and  additional  independent  mea¬ 
surement  (bearing)  the  system  observability  was  enhanced  con¬ 
siderably  and  we  were  then  able  to  track  the  sonobuoy '«  motion 

quite  accurately. 

Although  not  reported  m  the  last  section,  we  aho  looked 
at  the  use  of  time-delay  end  floppier  difference  measurements 
of  more  than  three  hydrophones  tas  opposed  to  time  delay, 
doppicr  difference,  and  bearing  measurements  of  just  three 
hydrophones)  as  •  means  of  improving  system  observability  In 
general,  it  was  found  that  if  one  had  n  hydrophones  with  n 
unknown  sound  speeds  from  the  sonobuoy  to  each  hydrophone, 
then  we  could  at  most  estimate  the  sonobuoy  state  vector  and 
fa-1 )  sound  speeds:  one  of  these  sound  speeds  had  to  be  known 
exactly  when  implementing  the  Kalman  filter. 

At  the  pment  time,  we  arc  continuing  research  m  this  area 
of  sonobuoy  state  and  sound  speed  estimation  to  more  fully 
explore  the  sensitivity  of  (he  estimation  process  to  geometrical 
placement  of  the  hydrophones,  lime  between  measurements,  etc. 
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Hydrophone  1 


Figure  1.  Hydrophone /sonobuoy  geometry. 
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Figure  Z.  Estimation  of  sonobuoy  states  using 
incorrect  sound  speeds. 
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Figure  3. 


Sonobuoy  estimation  error  and  standard 
deviation— incorrect  sound  speeds. 
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Figure  4*  Normalized  eigenvalues  of  the  information 
matrix. 
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Figure  5.  Estimation  of  sonobuoy  states. 


SOUND  SPEED.  C3  (FT/SEC*  SOUND  SPEED.  C,  (FT/SECI 

4940  4960  4980  5 000  5020  4750  4800  4850  4900  4950 


10  70  30  40 

COMPUTER  ITERATION 


COMPUTER  ITERATION 


LEGEND:  -  TRUTH  MODEL 

- STATE  ESTIMATE 


10  20  30  40 

COMPUTER  ITERATION 


Figure  6.  Estimation  of  sound  speeds. 
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Figure  7.  Sonobuoy  estimation  error  and 
standard  deviation. 
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Figure  8.  Sound  speed  estimation  and  standard 
deviation. 
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